#ifndef __CONTROL_H
#define __CONTROL_H

int Vertical(float Med,float Angle,float gyro_Y);
int Velocity(int encoder_left,int encoder_right);
int Turn(int gyro_Z);

extern float Vertical_Kp,Vertical_Kd;
extern float Velocity_Kp,Velocity_Ki;

#endif
